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FOREWORD 


* 


The  Analytic  Sciences  Corporation  (TASC),  6  Jacob  Way,  Reading  , 
Mass.  01867  is  presently  conducting  Integrated  Navigation-Satellite 
Inertial  system  analysis  studies  in  support  of  Air  Force  Avionics 
Laboratory  development  efforts.  The  work  reported  in  this  docu¬ 
ment  was  conducted  from  March  1972  through  January  1973  as  part 
of  Task  02  of  Advanced  Development  Program  666A  under  Air  Force 
Contract  F33615-72-C-1918.  The  preliminary  draft  of  this  report 
wasprepared  as  TASC  Report  No.  TR  332-land  submitted  for  review 
on  24  May  1973.  The  authors  acknowledge  the  assistance  of  the  Air 
Force  Project  Engineers  Capt.  Maurice  Carr  and  Capt.  Stephen 
Schwam  (NVA/666A). 
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A  simulation  of  an  integrated  airborne  621B  Satellite/Inertial 
navigation  system  is  planned  in  which  a  ground-based  beacon 
configuration  will  be  used  in  place  of  the  satellites.  The  TRW 
Systems  Group  has  designed  and  built  an  Megrated  Navigation 
Satellite Anertial  (INI)  system  and  will  participate  in  a  test  of 
this  equipment  for  the  Air  Force  Avionics  Laboratory  at  the 
White  Sands  Missile  Range  test  center. 
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This  study  represents  a  continuation  of  an  earlier  INI  flight 
test  support  study  conducted  by  TASC.  In  this  study  the  INI 
reference  system  error  model  is  first  revised  to  include  the 
most  current  data  on  inertial  system  and  beacon  errors.  Then 
an  18 -state  INI  Kalman  filter  for  integrating  beacon  receiver 
and  inertial  data  is  described.  The  filter  is  evaluated  in  a 
performance  study  which  includes  a  comparison  against  an 
optimally  integrated  INI  system  using  a  complete  33-state  ref¬ 
erence  error  model.  Special  attention  is  focused  on  the  con¬ 
ventional  baroaltimeter  damped  vertical  channel  mechanization 
proposed  by  TRW  and  the  problem  of  filter  initialization.  A 
component  error  budget  is  generated  for  the  18 -state  Kalman 
filter  to  identify  major  sources  of  system  error  and  filter  sen¬ 
sitivity  to  those  errors.  A  brief  review  of  the  TRW  flight  test 
program  is  then  presented.  -An  18 -state  INI  Kalman  filter  is 
recommendedfor  initial  use  in  the  flight  tests  and  certain  addi¬ 
tions  to  the  real  time  flight  test  data  display  and  diagnostics  are 
suggested. 
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1.  INTRODUCTION 

1.1'  BACKGROUND  AND  PURPOSE 

A  simulation  of  an  integrated  airborne  621B  Sateliite/lnertial 
navigation  system  is  planned  in  which  a  ground-based  beacon  configura¬ 
tion  will  be  used  in  place  of  the  satellites.  The  test  configuration  concept 
is  illustrated  in  Fig.  1.1-1.  The  TRW  Systems  Group  has  designed  and 
built  an  Integrated  Navigation  Sateliite/lnertial  (INI)  system  and  will  par¬ 
ticipate  in  a  test  of  this  equipment  for  the  Air  Force  Avionics  Laboratory 
(AFAL)  at  the  White  Sands  Missile  Range  (WSMR)  test  center. 


Figure  1.1-1 


The  INI  Test  Configuration 


In  these  tests  a  Kalman  filter  algorithm  will  be  used  to  integrate 
data  from  the  inertial  system  and  a  single  channel  time  multiplexed  beacon 
receiver.  Under  contract  to.  AFAL,  The  Analytic  Sciences  Corporation 
(TASC)  recently  completed  a  preliminary  INI  Kalman  filter  design 
study.  This  study  included  the  formulation  of  a  complete  reference  error 
model  for  the  INI  system  and  the  design  and  evaluation  of  two  reduced- 
state  INI  Kalman  filters.  The  results  of  this  study  are  reported  in  Ref.  1, 

The  work  reported  herein  is  a  continuation  of  the  TASC  study 
cited  above.  The  goals  of  the  present  study  are  to: 

•  Establish  the  latest  best  estimates  of  all  INI  error 
sources  and  refine  the  INI  reference  system  error 
model  accordingly. 

•  Optimize  an  INI  Kalman  filter  design  using  the 
revised  reference  error  model  placing  the  em¬ 
phasis  on  a  minimal  state  size  Kalman  filter 
mechanization. 

•  Review  and  comment  on  the  adequacy  of  the  TRW 
flight  test  program  to  appropriately  test  the  ef¬ 
fectiveness  of  the  Kalman  filter  in  the  INI  system. 

Reference  1  is  frequently  cited  in  the  present  work.  Whenever 
possible  the  notation  used  here  is  consistent  with  this  reference.  It  is 
assumed  that  the  reader  is  familiar  with  the  concepts  of  suboptimal 
Kalman  filter  design,  performance  evaluation  and  sensitivity  analysis  as 
presented  in,  for  example,  in  Ref.  2. 


1.2  REPORT  OVERVIEW 
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lii  Section  2  revisions  to  the  INI  reference  error  model  are 
first  discussed  and  an  18-state  INI  Kalman  filter  design  is  presented. 
Section  3  contains  a  detailed  performance  evaluation  of  the  18 -state 
Kalman  filter,  including  a  comparison  against  the  theoretically  best  per¬ 
formance  of  afully  optimally  integrated  INI  system.  The  conventional  ver¬ 
tical  channel  mechanization  proposed  by  TRW  is  contrasted  with  Kalman 
processing  of  altimeter  data  and  the  problem  of  filter  initialization  is 
discussed.  A  component  error  budget  is  developed  for  the  18-state  filter 
to  determine  major  error  sources  limiting  system  performance  and  filter 
sensitivities  to  those  error  sources. 

Section  4  contains  discussion  and  comment  on  the  TRW  flight 
test  program.  Finally  in  Section  5  the  results  of  this  study  are  sum¬ 
marized  and  TASC’s  conclusions  and  recommendations  are  enumerated. 
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2. 


A  REVISED  INI  REFERENCE  ERROR  MODEL 
AND  KALMAN  FILTER  DESIGN 


The  INI  reference  error  model,  originally  developed  in  Chapter 
3  of  Ref.  1,  has  been  revised  to  reflect  the  results  of  the  study  reported 
therein  and  the  availability  of  later  and  move  complete  information  on 
inertial  sensor  and  beacon  errors.  The  15-state  INI  Kalman  filter  first 
described  in  Ref.  1  has  been  augmented  to  an  18 -state  filter  with  further 
refinements  in  its  design  parameters.  Both  the  updated  INI  reference 
error  model  and  revised  Kalman  filter  design  model  are  described  in  this 
section. 


2. 1  AN  UPDATED  INI  REFERENCE  ERROR  MODEL 

The  reference  system  error  model  used  in  the  first  INI  Support 
Study  was  described  in  detail  in  Chapter  3  of  Ref.  1.  This  model  in¬ 
cluded  beacon  range  and  ran^e-rate  errors,  baro -altimeter  errors,  and 
inertial  system  errors  corresponding  to  the  AN/ASN-90  Inertial  Measure  ¬ 
ment  Set  (IMS).  As  a  result  of  these  studies,  and  in  particular,  the 
component  error  budget  generated  therein,  and  the  recent  availability  of 
a  detailed  IMS  error  model  (Ref.  3),  the  INI  reference  error  model  has 
been  updated.  This  section  describes  only  the  changes  between  the 
reference  system  error  models  of  this  and  the  previous  study. 

In  Table  2.1-1  the  reference  error  model  state  selection  used 
in  this  study  is  compared  with  that  used  in  Ref.  1.  The  major  differences 
between  the  two  models  lie  in  the  area  of  inertial  instrument  errors. 
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TABLE  2.1-1 


INI  SYSTEM  REFERENCE  ERROR  MODEL  COMPARISONS 


No.  of  States 

No.  of  States 

Error  State  Quantity 

Flight  Test 
Support  Study 
Model  (Ref.  1) 

Current 

INI 

Model 

Comment 

Position 

3 

3 

Unchanged 

Velocity 

3 

3 

Unchanged 

Platform  Tilt 

3 

3 

Unchanged 

Altimeter 

'  2 

2 

Unchanged 

Gyro  Bias 

O 

U 

3 

Unchanged 

Gyro  G-Sensitive 

3 

3 

Unchanged 

Gyro  Scale  Factor 

3 

- 

Deleted 

Gyro  Random 

- 

- 

White  Noise 

Accelerometer  Bias 

3 

3 

Unchanged 

l  Accelerometer  Scale  Factor 

- 

2 

Added 

Accelerometer  Random 

- 

- 

White  Noise 

Accelerometer  Misalignment 

- 

3 

Added 

User  Clock 

2 

2 

Relative 

Clock 

Beacon  Clocks 

8 

6 

Relative 

Clocks 

TOTAL* 

33 

33 

♦Total  does  not  include  random  terms  which  were  modeled  as  part  of  the 
system  white  noise  vector. 


Basically,  the  current  reference  error  model  was  obtained  from  the 
earlier  model  by  eliminating  gyro  torquer  scale  factor  errors  and  adding 
accelerometer  scale  factor  and  misalignment  errors. 


The  AN/ASN-90  Inertial  Measurement  Set  (IMS)  will  be  used  in 
the  INI  tests.  The  inertial  instrument  error  models  used  in  our  first 
study  were  transmitted  to  TASC  verbally  by  the  IMS  vendor.  For  the 
present  study  a  complete  listing  of  inertial  instrument  error  models  was 
available  (Ref.  3).  The  additional  inertial  instrument  errors  not  included 
in  our  first  INI  study  reference  system  error  model  are  gyro  input  axis 
misalignments  and  accelerometer  scale  factor  and  input  axis  misalign- 
ments.  These  are  all  bias -type  errors.  If  all  these  errors  were  modeled, 
they  would  add  15  more  states  to  the  INI  reference  error  model.  However 
as  discussed  below  many  of  these  errors  were  eliminated  by  appealing  to 
physical  reasoning  and  the  error  budget  results  of  the  first  study. 

The  first  INI  component  error  budget  reported  in  Ref.  1  showed 

that  gyro  torquer  scale  factor  error  contribution  to  any  INI  system  error 

was  insignificant  (<  1%).  Gyro  drift  rate  error  caused  by  gyro  input  axis 

misalignments  has  the  same  mathematical  form  as  the  drift  rate  error 

caused  by  torquer  scale  factor  errors.  Furthermore  since  the  gyro  input 

axis  misalignments  are  comparable  in  magnitude  to  the  scale  factor  errors 
-4  -4 

(2.9  x  10  vs.  3.0  x  10  ),  they  will  produce  comparable  drift  rate 

errors.  We  may  therefore  conclude  that  gyro  misalignments  will  not  cause 
significant  system  errors.  Neither  gyro  torquer  scale  factor  nor  input 
axis  misalignment  angles  are  included  in  the  present  INI  reference  system 
error  model. 

The  flight  profiles  recommended  by  TRW  in  Ref.  7  will  produce 
lateral  accelerations  of  up  to  0.3  g.  In  the  presence  of  this  acceleration, 
the  horizontal  accelerometer  scale  factor  terms  produce  acceleration 
errors  of  60  which  are  comparable  to  the  level  accelerometer  null 
bias  terms.  These  terms  were  therefore  included  in  the  INI  reference 
error  model.  Since  the  simulated  flights  are  at  constant  altitude,  the 


TABLE  2.1-2 


f- 1  L 

it  *•* 


vertical  accelerometer  is  sensing  g  only.  Therefore  the  acceleration 
error  induced  by  vertical  accelerometer  scale  factor  is  a  constant  and 
indistinguishable  from  the  vertical  accelerometer  null  error.  The 
rms  value  of  the  vertical  accelerometer  null  error  state  has  been 
adjusted  to  include  the  effect  of  vertical  accelerometer  scale  factor 
error  so  that  no  additional  state  is  required  to  model  this  error. 

The  accelerometer  input  axis  misalignment  terms  are  also  sig¬ 
nificant.  The  0.3g  lateral  acceleration  acting  through  the  stated  mis¬ 
alignments  will  produce  roughly  90/ig  acceleration  error,  again  compar-  * 
able  to  the  null  bias  errors.  The  -number  of  states  used  to  represent  the 
accelerometer  misalignments,  however  may  be  reduced  from  six  to  three. 

In  general  six  quantities  are  required  to  specify  the  small 
angle  misalignments  of  an  instrument  triad  relative  to  some  nominal 
platform  frame.  However, the  definition  of  the  platform  frame  is  some¬ 
what  arbitrary,  and  since  we  have  already  eliminated  gyro  input  axis  mis¬ 
alignment  terms  from  our  error  model, it  is  advantageous  to  define  the 
platform  frame  with  respect  to  the  accelerometer  axes  in  a  manner  which 
will  minimize  the  number  of  misalignment  errors.  Since  the  acceler¬ 
ometers  are  used  to  level  the  platform  it  is  appropriate  to  place  the 
platform  level  axes  in  the  plane  defined  by  the  level  (N,  E)  accelerometers. 
Further  if  the  platform  east  axis  is  selected  to  coincide  with  the  east 
accelerometer  input  axis  only  one  level  misalignment  term  remains, 
a'-K-rry-  Of  course  the  vertical  accelerometer  misalignment  errors  are 
still  present.  Also,  it  is  seen  from  Fig.  2.1-2  that  the  misalignment  of 
the  north  accelerometer  input  axis  relative  to  the  east  accelerometer 
input  axis,  can  vary  m  magnitude  from  zero  to  +  “ez*  Since 

^NZ  aEZ  are  assume<*  *°  independent  and  identically  distributed 
we  have 


W  kt  iWt  k  4*1  Ah  ifti;  &  WJti  "«fii  1. Ms  )  * 


w  jpjMflW  f;  W w 


E 


h 


2' 

NZ 


r  2 " 

=  2ELaNZ. 


(2.1-1) 


where  E  (•)  is  the  ensemble  expection  operator  (average  value).  The 
mean  values  of  a. 'rm  and  must  also  be  doubled  where  a  r,^T  and  a* 

Lri  /OiL  liis  L  Hi 

are  the  vertical  accelerometer  input  axes  misalignments  relative  to  the 
perpendicular  to  the  plane  of  and  A^.  Thus  the  same  total  mean 
square  misalignment  error  is  present  whether  represented  by  three  or 
six  variables. 
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One  more  state  model  change  deserves  mention.  In  Section 
4.2  of  Ref.  1,  it  was  shown  that  only  the  phase  and  frequency  differences 
(i.e.,  relative  phase  and  frequency)  between  beacon  and  user  clocks  was 
observable.  The  performance  evaluations  of  Section  5  of  that  report 
further  showed  that  only  relative  synchronization  of  user  and  beacon 
clocks  was  required  for  proper  system  operation.  This  fact  was  used  to 
replace  the  five  absolute*  clock  phase  and  frequency  errors  (1  user  and 


R-8993 


(IN,IE,IZ)  -  Ideal  orthogonal  accelerometer  set,Ii  into  paper 
( -  Actual  accelerometer  input  axis  orientation 

f  igure  2.1-2  Accelerometer  Misalignments  in  the 

Plane  of  the  Level  Accelerometer  Axes 


♦Absolute  errors  would  be  errors  relative  to  a  primary  time -frequency 
standard,  i.e.,  anatomic  clock 
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4  beacons)  with  four  relative  clock  error  models  in  the  p:  -  ■. 

reference  system  error  model. 

The  initial  value  of  the  beacon  clock  frequency  errors  may  be 
as  large  as  1  part  in  10^  rather  than  the  value  of  1  part  in  10^  used  in 
Ref.  1.  This  represents  a  range-rate  error  of  10  ft/sec  and  accounts  for 
the  fact  that  the  beacon  clocks  may  not  be  synchronized  before  each  flight. 
As  we  shall  see  in  Section  2.3,  this  change  in  initial  frequency  offset 
error  will  directly  impact  INI  Kalman  filter  state  size. 

The  INI  Reference  System  error  model  state  complement  and 
the  initial  values  assumed  for  each  state  in  the  performance  evaluation 
to  be  described  are  listed  in  Table  2.1-2.  A  complete  state  space  des¬ 
cription  of  the  INI  reference  error  model  is  given  in  Appendix  A.  Changes 
in  the  vertical  channel  error  equations  which  differ  from  the  earlier  study 
are  discussed  in  more  detail  in  the  next  paragraph. 

2. 2  THE  VERTICAL  CHANNEL  MECHANIZATION 

Due  to  the  manner  in  which  gravity  is  computed,  the  IMS  verti¬ 
cal  (altitude)  channel  computations  are  intrinsically  unstable.  Whenever 
one  builds  a  suboptimal  Kalman  filter  for  an  unstable  plant,  the  possibility 
of  filter  divergence  exists,  i.e. ,  filter  estimation  errors  may  grow  arbi¬ 
trarily  large  in  time.  Examples  of  vertical  channel  error  divergence  in 
a  Kalman  filter  integrated  satellite/inertial  system  were  given  in  Ref.  5. 
It  was  further  indicated  in  that  reference  that  this  divergence  problem  is 
most  easily  and  reliably  eliminated  by  stabilizing  the  vertical  channel 
using  conventional  baro -altimeter  damping. 


TRW  will  mechanize  a  baro -altimeter  damped  vertical  loop  for 
the  INI  flight  tests.  The  mechanization  equations  were  originally  developed 
by  the  IMS  vendor  and  are  described  in  Ref.  6.  The  mechanization  to  be 
used  is  shown  in  Fig.  2.2-1.  Symbols  used  in  the  figure  are  defined 


below: 


=  sensed  vertical  acceleration  (specific  force) 

=  gravity  compensation,  a  function  of  altitude  and 
latitude 

=  vertical  velocity. 

=  0.00111/sec2 
=  0.06666/sec 


R  r 


=  inertially  derived  altitude 
=  altimeter  measured  altitude 
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Figure  2. 2-1  INI  Vertical  Channel  Mechanization 
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In  the  mechanization,  inertially  derived  altitude  is  compared 
with  barometric  altitude  and  the  difference  is  fed  back  through  appropriate 
gains  to  stabilize  the  loop.  The  constants  and  Dg  were  selected  to 
yield  a  critically  damped*  second  order  loop  with  a  time  constant,  T,  of 
thirty-two  seconds.  The  relationship  between  the  feedback  gains  and  the 
loop  time  constant  is 


Di  ■  ^ 


>?2  =  T 


(2.2-1) 


(2.2-2) 


The  altimeter  response  displays  a  transport  lag;  that  is,  the 
current  output  of  the  device  is  proportional  to  a  slightly  earlier  value  of 
altitude.  Thus,  as  shown  in  Fig.  2.2-1,  inertially  indicated  altitude  is 
delayed  by  a  similar  amount  before  the  comparison  is  made.  This  lag  is 
typically  of  the  order  of  0. 1  sec  which  is  quite  small  compared  to  the 
loop  time  constant. 


where 


The  sensed  acceleration  is  of  the  form 


Ag  =  h  -  g  +  Coriolis  term 

+  acceleration  errors 


h  -=  2nd  time  derivative  of  altitude 


(2.2-3) 


If  the  gravity  compensation  and  Coriolis  terms  have  been  computed  cor¬ 
rectly,  and  if  accelerometer  and  altimeter  errors  are  ignored  (including 
transport  lag),  the  Laplace  transform  of  inertial  altitude  can  be  written  as 


*A  critically  damped  second  order  loop  has  two  equal  negative  real  roots. 
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(2.2-4) 


h  (s)  +  (D  s  +  Djh(s) 
hj  (s)  =  -  2 - 1 - 

s  +  D2s+  Dj 

where  s  is  Laplace  transform  variable.  Ignoring  initial  conditions 

K(s)  =  s2h(s)  (2.2-5) 

so  that  Eq.  (2. 2-4)  becomes 

s2h(s)  +  (D2s  +  D.)h(s) 

hI  &  =  - 2 -  =  h(s)  (2.2-6) 

s  +  Dg  s  +  Dj 

That  is,  inertially  indicated  altitude  is  equal  to  true  altitude.  Thus  in  the 
absence  of  errors  the  vertical  channel  mechanization  is  dynamically  exact; 
that  is,  there  are  no  errors  due  to  true  motion. 

The  error  equations  for  the  damped  vertical  channel  are  the 
same  as  those  of  the  free  inertial  system,  derived  in  Ref.  2,  except  for 
the  added  damping  terms.  These  equations  are  presented  in  Appendix  A. 
Note  that  the  effect  of  transport  lag  has  been  ignored  in  these  equations. 
This  effect  is  important  only  during  very  high  rates  of  climb  or  descent 
and  has  no  effect  on  the  flight  profiles  considered  in  this  report.  Using 
the  system  error  equations,  an  error  diagram  for  the  vertical  channel 
can  be  drawn  as  shown  in  Fig.  2. 2-2.  The  symbols  used  are  defined  in 
Table  2.1-2  and  Appendix  A.  The  velocity  and  acceleration  errors, 

6hCA  311(1  6VZCA  resPectively>  are  given  by  Eq.  (2. 2-6)  and  Eq„  (2. 2-7), 
respectively. 
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Figure  2. 2-2  Vertical  Channel  Error  Block  Diagram 
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2.3  AN  18 -STATE  INI  KALMAN  FILTER 


TASC  efforts  in  this  study  center  on  the  design  of  a  minimal 
state  size  filter  for  the  INI  System  flight  tests.  In  the  design  of  a  practi¬ 
cal  Kalman  filter  for  any  system,'  there  is  generally  a  minimal  set  of 
errors  (i.e.  states)  which  must  be  estimated  if  the  integrated  system  is 
to  remain  stable  and  meet  acceptable  error  performance  levels.  Reference  1 
presented  a  15-state  Kalman  filter  design,  which  at  that  time  was  con¬ 
sidered  a  minimal  state  size  filter  for  the  INI  system.  This  minimal  state 
selection,  however,  was  based  on  the  understanding  that  beacon  clock  fre¬ 
quencies  would  be  synchronized  to  1  part  in  10^  or  better.  This  represents 
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a  range-rate  error  of  0.1  ft/sec  or  less.  In  light  of  this  accurate  syn¬ 
chronization,  estimation  of  beacon  clock  drift  rates  was  deemed  unneces¬ 
sary  and  these  errors  were  not  modeled  in  the  15 -state  filter.  How’ever, 
the  error  budget  reported  in  Ref.  1  showed  that  87%  of  user  clock  frequency 
error  was  caused  by  unmodeled  beacon  clock  frequency  offset.  Effectively, 
a  beacon  clock  frequency  error  translated  one-for-one  to  a  user  clock  fre¬ 
quency  error.  Thus  if  the  unmodeled  beacon  clock  frequency  offsets 
became  large,  user  clock  synchronization  with  the  15-state  filter  would 
not  be  possible. 

Subsequent  to  the  release  of  Ref.  1  TRW  indicated  that  highly 
accurate  beacon  clock  synchronization  measurements  may  not  be 
routinely  performed  by  the  test  site  operators  prior  to  each  flight. 
Consequently,  frequency  differences  between  beacon  clocks  could  be  as 

O 

large  as  1  part  in  10  ,  which  represents  an  equivalent  range-rate  error 
of  10  ft/sec.  With  range-rrte  errors  of  this  magnitude,  the  TRW  single 
channel  receiver  will  probably  not  acquire  the  beacons  when  operating  in 
the  narrowband  aided  acquisition  mode.  Thus  the  beacon  relative  fre¬ 
quency  offset  errors  must  be  estimated.  There  are  three  beacon  fre¬ 
quency  offset  errors  relative  to  beacon  No.  1.  If  these  errors, are  added 
to  the  15 -states  of  the  ''original"  INI  Kalman  filter,  one  obtains  the  18- 
state  compliment  used  in  this  study. 

The  state  vector  for  the  INI  18 -state  filter  design  model  is 
listed  in  Table  2.3-1  together  with  the  rms  initial  values  assumed  for 
these  errors  in  the  performance  evaluation  and  error  budget  analysis  of 
sections  3.1  and  3.2.  In  addition  to  the  nine  inertial  system  errors, this 
filter  estimates  user  and  beacon  clock  relative  phase  and  frequency  errors 
and  altimeter  bias.  If  the  altimeter  bias  were  not  modeled,  an  altitude 
error  equal  to  the  bias  would  be  obtained.  This  error  is  unacceptably 
large  (200  ft). 
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TABLE  2.3-1 

STATE  VECTOR  FOR  18-STATE  INI  FILTER  DESIGN  MODEL 


State  Symbol 

1  61^ 

2  6R  * 

E 


6V 

6V 

6V  * 
Z 


Description 


Nortli 

East 

Vertical 

North 

East 

Vertical 

North 

East 

Vertical 


Positiu..  Error 


Velocity  Error 


Platform  Tilts 


10 

6hAl 

Bias 

|  Baroaltimeter 

11 

12 

6t; 

6T* 

u 

Phase  Error 

Frequency  Offset  j 

|  User  Clock^ 

13 

«T2 

Phase  Error  j 

(,  Beacon^ 

14 

6T| 

Frequency  Offset  j 

\  No.  1  Clock 

15 

5T3 

Phase  Err^r  | 

[  Beacon^ 

16 

atj 

Frequency  Offset  j 

No.  2  Clock 

17 

«T  * 

Phase  Error  j 

[  Beacon 

18 

6f| 

Frequency  Offset  j 

No.  3  Clock 

RMS  Initial  Value 

1500  ft 
1500  ft 
200  ft 

8  ft/sec 
8  ft/sec 
8  ft/sec 

0.6  min 
0.6  min 
6.0  min 

200  ft 

104  ft 
10.0  ft/sec 

5000  ft 
10. 0  ft/sec 

5000  ft 
10.0  ft/sec 

5000  ft 
10.0  ft/sec 


t  Relative  to  Beacon  No.  1 


In  the  previous  study  of  Ref.  1  the  Kalman  filter  processed 
range  and  range  rate  information  and  altimeter  data.  In  the  present  study, 
however,  the  altimeter  is  used  to  damp  the  vertical  channel  in  the  conven¬ 
tional  manner  as  described  in  the  previous  section.  Thus  the  present  18- 
state  INI  filter  processes  beacon  range  and  range-rate  data  only. 
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Finally,  we  note  that  all  unmodeled  error  sources  in  the  18- 
state  filter  have  been  accounted  for  by  additional  white  noise  inputs  to 
the  18-state  filter  design  model.  This  is  a  standard  approach  to  sub- 
optimal  Kalman  filter  design  which  has  been  discussed  extensively  in 
connection  with  the  previous  satellite  and  beacon/inertial  Kaiman  filter 
design  studies  of  Refs.  1  and  5.  A  complete  state-space  description  of  the 
18-state  filter  is  given  in  Appendix:  B.  A  simplified  diagram  of  the  INI 
Kalman  filter  mechanization  is  shown  in  Fig.  2.3-1.  In  this  study,  it  is 
assumed  that  each  system  state  that  is  estimated  is  impulsively  corrected 
with  the  negative  of  its  estimate.  This  implies  reset  of  position  and 
velocity  integrators,  reset  of  clock  phase  accumulators  and  rapid  torquing 
of  the  platform  to  correct  tilts. 


K-4)S4a 


Figure  2.3-1  INI  Kalman  Filter  Mechanization 
(Conventional  Vertical  Channel) 
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3  *  18 -STATE  BEACON/INERTIAL  KALMAN  FILTER 

PERFORMANCE  EVALUATION 


(U)  The  general  strategy  for  Kalman  filter  performance  evaluation 

is  now  well  established.  In  this  section  the  error  performance  of  an  optimally 
integrated  INI  system  represented  by  the  33 -state  reference  error  model 
is  first  determined  for  a  selected  flight  profile.  The  error  performance' 
of  the  18-state  INI  Kalman  filter,,  is  then  predicted  under  the  same  condi¬ 
tions  and  compared  against  the  baseline  optimal  results .  A  component  error 
budget  is  next  generated  for  the  18 -state  filter  to  isolate  major  integrated 
system  error  sources  and  determine  filter  sensitivity  to  these  error 
sources.  This  section  also  contains  a  comparison  of  the  current  18 -state 
INI  Kalman  filter  and  the  preliminary  15 -state  filter  design  reported  in 
Ref.  1.  The  section  ends  with  a  discussion  of  the  filter  initialization 
problem.  All  performance  predictions  cited  in  this  section  were  gener¬ 
ated  with  the  time-varying  version  of  the  covariance  error  analysis  pro¬ 
gram  described  in  Ref.  2. 

3.1  BASELINE  OPTIMAL  AND  18-STATE  FILTER  COMPARISON 

The  flight  profile  used  in  the  performance  evaluation  to  be 
described  is  shown  in  Fig,  3.1-1.  The  beacon  geometry  is  identical  to 
that  recommended  and  used  in  the  studies  reported  in  Ref.  1.  The 
flight  profile  consists  of  three  circuits  over  the  beacon  net  at  an  altitude 
of  30, 000  ft,  and  a  speed  of  400  ft/sec.  Range  and  range -rate  data  from 
a  single  beacon  are  processed  every  six  seconds.  This  figure  represents 
the  expected  maximum  time  required  for  the  beacon  receiver  to  break  lock 
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Figure  3.1-1  Beacon/Inertial  Test  Flight  Profile 

with  one  beacon,  lock  on  to  the  next  beacon  and  obtain  the  desired  meas¬ 
urement.  Beacon  data  is  processed  in  a  1,  2,  3,  4  sequence  beginning  at 
T  =  6  sec .  The  above  profile  is  identical  to  the  active  phase  portion  of 
the  flight  profile  used  in  Ref.  1  in  order  to  facilitate  comparisons  between 
the  two  studies.  Initial  conditions  for  each  of  the  system  errors  and  error 
sources  were  listed  in  Section  2.  The  initial  navigation  errors  are  repres¬ 
entative  of  a  half-hour  free  inertial  flight  to  the  test  area.  The  inertial 
instrument  errors  and  clock  phase  and  frequency  errors  are  as  described 
in  Section  2. 

(U)  Plots  of  selected  navigation  errors  as  a  function  of  time  are 

shown  in  Fig.  3. 1-2  for  the  optimal,  and  18 -state  filters.  Altimeter 
bias,  and  user  clock  relative  phase  and  frequency  errors  are  compared 
in  Fig.  3.1-3.  Because  of  the  large  change  in  most  error  variables  over 
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Figure  3.1-3  Comparison  of  rms  Altimeter  Bias  and  User  Rela 
Clock  Errors  in  the  Optimal  and  18-State  Filte 
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the  active  phase,  the  scaling  of  most  of  these  plots  does  not  permit  easy 
visualization  of  performance  differences  between  the  two  filters.  Note, 
however,  that  the  error  curves  for  the  18 -state  filter  are  very  similar 
to  those  of  the  optimal  filter,  and  that  all  important  system  error  sources 
are  bounded  and  near  their  final  values  within  the  first  circuit  of  the  sim¬ 
ulated  flight.  With  regard  to  the  user  clock,  it  is  seen  that  the  large 
initial  drift-rate  is  highly  observable  and  quickly  calibrated.  The  major 
portion  of  user  clock  phase  and  drift-rate  errors  have  been  removed  in 
the  first  third  of  the  first  circuit  (120  sec). 

Further  comparison  of  the  optim?,l  and  18-state  filters  is  most 
'  easily  done  in  tabular  form.  Numerical  values  for  the  errors  of  interest 
are  given  in  Table  3.1-1  for  both  filters  at  the  end  of  one,  two,  and  three 
circuits.  Note  that  at  all  times  listed  the  radial  position  error  of  the  18- 
state  filter  is  roughly  40%  above  optimal.  For  example,  at  the  end  of 
three  circuits  the  radial  position  errors  for  the  optimal  and  18-state 
filters  are  17.8  ft  and  25.6  ft  respectively.  As  we  shall  see  when  the 
error  budget  is  discussed, the  major  portion  of  this  increase  is  caused  by 
altimeter  markov  error  which  is  not  estimated  in  the  18-state  filter. 

With  regard  to  radial  velocity  error,  18 -state  filter  perform¬ 
ance  has  stabilized  out  over  the  last  circuit  at  approximately  0.4  ft/sec. 
Radial  velocity  error  for  the  optimal  filter  averages  about  0.2  ft/sec  over 
this  circuit. 

At  the  end  of  three  circuits, altimeter  bias  and  user  clock  phase 
errors  at  8.8  ft  and  11.8  irrespectively,  are  very  close  to  the  optimal 
altimeter  bias  and  clock  phase  errors  of  8.4  ft  and  9.7  ft.  User  clock 
drift  rate  for  the  optimal  filter  at  the  end  of  3  circuits  is  0.02  ft/sec 
versus  0.035  ft/sec  for  the  18-state  filter.  If  this  latter  figure  is 
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TABLE  3.1-1 


OPTIMAL  AND  18 -STATE  FILTER  PERFORMANCE  COMPARISON 
DURING  BEACON  MEASUREMENT  PHASE 


RMS 

Error 

Units 

T  ~  0 

T  =  360  secs 

T  =  720  secs 

T  = 

’080 

Both 

Optimal 

18-State 

Optimal 

18 -State 

Optimal 

18 -State 

min 

3.0 

1.34 

1.63 

0.49 

0.84 

0.43 

0.80 

4000 

35.6 

56.5 

12.6 

17.4 

9.7 

15.1 

«re 

ft. 

4000 

27.5 

40.6 

9.8 

14.8 

8.6 

13.7 

6h 

2G0 

17.7 

21.0 

13.3 

16.0 

12.2 

15.5 

& 

O 

ft. 

5660 

48.3 

72.7 

20.8 

27.9 

17.8 

25.6 

6Vn 

8.0 

0.23 

0.32 

0.11 

0.15 

0.08 

0.15 

6Ve 

ft/sec 

8.0 

0.36 

0.51 

0.10 

0.15 

0.08 

0.15 

1.0 

0.18 

0.32 

0.15 

0.35 

0.14 

0.36 

|6V| 

ft/sec 

8.1 

0.46 

0.68 

0.21 

0.41 

0.18 

0.42 

6hA 

ft. 

200 

15.9  . 

18.1 

9.3 

9.7 

8.4 

8.8 

$Tu 

•fi. 

It. 

104 

23.3 

33.3 

10.6. 

11.7 

9.7 

11.8 

6TU 

ft/sec 

10 

0.13 

0.18 

0.02 

0.03 

0.02 

0.03 

reflected  through  a  horizontal  CEP  GDOP  of  4*  this  represents  a  position 
drift  rate  of  0,14  ft/sec  or  0. 12  nm/hr.  which  is  roughly  an  order  of 
magnitude  better  than  the  basic  quality  of  the  AN/ASN-90  IMS. 

Vertical  channel  performance  deserves  special  mention  since  we 
we  have  introduced  conventional  altimeter  damping  in  this  study.  Using 
techniques  presented  in  Ref.  8,  it  is  possible  to  compute  the  steady-state 

*This  GDOP  is  typical  of  the  simulated  profile.  See  Section  2  of  Ref.  1. 
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position  and  velocity  errors  of  the  damped  vertical  (DV)  channel  caused 
by  altimeter  bias  and  random  errors*  and  accelerometer  null  bias 
errors.  These  errors  are  listed  in  Table  3.1-2  under  the  heading  ”DV”. 
From  the  error  budget  studies,  which  are  described  more  fully  in  the 
next  section,  one  obtains  the  vertical  channel  response  to  these  same 
error  sources  in  the  Kalman  filter  aided  mode. 

TABLE  3.1-2 

COMPARISON  OF  STEADY  STATE  DAMPED  VERTICAL  CHANNEL 
RESPONSE  IN  AIDED  AND  UNAIDED  MODES 
(18 -STATE  KALMAN  FILTER) 


RMS 

Vertical  Position 
Error  (ft) 

RMS 

Vertical  Velocity 
Error  (ft/sec) 

DV 

Aided  DV 

DV 

Aided  DV 

200.0 

0.5 

0.125 

-0 

18.6 

13.0 

0.25 

0.23 

3.5 

0.74 

1.37 

0.05 

Error  Source 
Altimeter  Bias 

jJj 

Altimeter  Random 
Accelerometer  Bias 


Notice  that  although  the  Kalman  aided  performance  is  always 
better  than  the  DV  performance  in  all  error  sources,  the  18 -state  Kalman 
filter  is  most  effective  in  reducing  bias  type  errors.  For  example,  in  the 
straight  DV  mode,  altimeter  bias  is  by  far  the  dominant  source  of  altitude 
error.  In  the  aided  mode,  however,  the  effect  of  altimeter  bias  is  essen¬ 
tially  removed  and  altimeter  random  error  dominates.  The  effect  of 
altimeter  random  error  could  be  reduced  by  modeling  the  altimeter 
marlcov  in  the  Kalman  filter  or  by  decreasing  the  bandwidth  of  the  vertical 
channel  (i.e.,  increasing  T).  However,  neither  approach  seems  warranted 
at  this  time  since  the  altimeter  random  error  model  is  not  well  known. 


Altimeter  random  errors  consist  of  an  altimeter  markov  error  plus  a 
white  noise  quantization  error. 


_ _ _ . 


3.2  THE  COMPONENT  ERROR  BUDGET  FOR  TIDE  18-STATE  FILTER 


A  component  error  analysis  is  used  to  determine  the  contribu¬ 
tion  of  each  INI  system  error  source  to  the  overall  error  performance  of 
the  INI  Kalman  filter.  In  this  manner  dominant  error  sources  are  brought 
to  light  and  filter  sensitivity  to  each  error  source  is  quantified.  The 
component  error  budget  for  the  18 -state  filter  has  been  computed  at  the 
end  of  two  circuits  (T  =  720  sec)  of  the  active  phase.  At  this  time  all 
navigation  and  clock  errors  have  reached  uniformly  low  levels.  Thus  it 
should  be  possible  to  determine  what  errors  are  limiting  steady-state 
filter  performance. 

The  component  error  budget  immediately  after  a  measurement 
is  listed  in  Table  3. 2-1,  Dominant  contributors  to  each  error  are  boxed 
in  tiie  table.  Histograms  showing  the  percentage  contribution  of  various 
error  sources  to  position  and  velocity  errors,  heading  error,  and  user 
clock  relative  phase  and  frequency  errors  are  presented  in  Figs.  3.2-1 
through  3.2-3. 

According  to  Fig.  3.  2-1,  approximately  70%  of  the  total  mean 
square  radial  position  error  is  produced  by  the  altimeter  markov  error 
and  altimeter  quantization  error.  Measurement  noise  produces  another 
11%  of  the  radial  position  error.  Thus  during  the  active  phase  the  INI 
system  position  errors  are  largely  a  function  of  the  external  references 
and  not  strongly  influenced  by  inertial  system  errors.  Vertical  channel 
and  level  position  error  histograms  are  also  shown  in  Fig.  3.2-1. 
Altimeter  random  error  which  is  not  modeled  in  the  18 -state  filter  is 
seen  to  produce  66%  of  the  mean  square  vertical  position  error.  This 
figure  is  consistent  with  the  vertical  channel  position  error  budget  re¬ 
ported  in  Ref.  1  for  a  20-state  ITU  Kalman  filter  with  no  random  altime¬ 
ter  error  model.  Altimeter  random  errors  also  produce  75%  of 
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the  mean  square  level  position  error.  This  is  a  direct  consequence  of 
the  conventional  altimeter  damping  of  the  vertical  channel  mechaniza¬ 
tion  used  in  the  present  study.  In  the  previous  study  where  the  altimeter 
was  processed  as  a  Kalman  measurement, level  channel  accuracy  was  not 
sensitive  to  altimeter  errors.  Thus  we  have  some  measure  of  the  price 
paid  to  stabilize  the  vertical  channel.  Note  that  the  effect  of  inertial 
system  initial  conditions  and  user  and  beacon  clock  errors  on  position 
errors  is  insignificant,  attesting  to  the  high  observability  of  these  error 
sources. 


Turning  now  to  velocity  errors,  Fig.  3. 2-2  shows  that  altime¬ 
ter  random  error  and  range-rate  measurement  noise  contribute  almost 
equally  to  total  radial  velocity,  being  37%  and  34%  of  the  total  mean 
square  error.  Accelerometer  scale  factor  and  misalignment  constitute 
the  third  major  source  with  12%  of  the  velocity  error  budget.  The 
individual  vertical  and  horizontal  velocity  error  histograms  of  Fig.  3.2-2 
give  a  clearer  picture  of  what  is  happening.  From  the  vertical  velocity 
histogram  we  see  that  measurement  noise,  and  altimeter  random  produce 
most  of  the  vertical  velocity  error.  From  Table  3.2-1  the  actual  percen¬ 
tage  contributions  are  seen  to  be  46%  and  42%-respectively.  This  may  be 
contrasted  with  the  horizontal  velocity  error  where  accelerometer  scale 
factor  and  misalignment  errors  cause  50%  of  the  mean  square  horizontal 
velocity  error  and  altimeter  random  errors  produce  another  25%  of  this 
error.  Thus  accelerometer  scale  factor  and  misalignment  errors  are 
the  major  source  of  horizontal  velocity  error  and  their  inclusion  in  the 
INI  reference  error  model  is  justified.  The  reason  for  this,  of  course, 
is  largely  a  fu.  tion  of  the  flight  profile  selected.  The  circular  flight 
profile  produces  a  constant  centrifugal  acceleration  of  approximately  0.2g 
in  the  level  plane.  This  acceleration  couples  direc'ly  into  the  error  pro¬ 
cess  through  the  accelerometer  scale  factor  and  misalignment  errors. 
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In  an  unaceelerated  flight  profile,  these  would  not  be  significant  error 
sources. 

As  shown  in  Fig.  3. 2-3  heading  error  is  dominated  by  accel¬ 
erometer  errors,  which  produce  79%  of  the  error  in  this  category.  From 
table  3.2-1  it  is  seen  that  accelerometer  misalignment  errors  cause  69% 
of  the  heading  error.  The  dynamics  of  heading  error  recovery  are  dis¬ 
cussed  at  length  in  Section  5. 2  of  Ref.  5.  We  simply  note  here  that 
heading  error  is  not  directly  observable  from  position  and  velocity  fixes. 
Rather  heading  error  is  estimated  by  the  Kalman  filter  from  its  know¬ 
ledge  of  position  and  velocity  errors  and  the  inertial  system  dynamics 
which  relate  these  errors  to  heading  error.  For  example,  the  dif¬ 
ferential  equation  for  north  velocity  error  has  the  form 

=  6RN  +  *  **  +  Z  +  ^E^NE  (3.2-1) 

From  this  equation  we  see  that  heading  error,  0^,,  and  north  accelerome¬ 
ter  misalignment  about  east,  couple  into  the  north  velocity  error 

equation  through  the  common  gain,  A„,  which  is  the  east  component  of 

Ej 

vehicle  acceleration.  The  18 -state  filter  does  not  model  accelerometer 
misalignment,  so  that  its  model  of  north  velocity  error  has  the  form 


6VN‘  =  iF  6Rn  +  •••  +AE'SZ  (3'2'2) 

Now,  since  heading  error  and  accelerometer  misalignment  affect  north 
velocity  in  the  same  manner  and  since  the  18 -state  filter  does  not  model 
the  affect  of  on  north  velocity  is  incorrectly  attributed  to 
heading  error  in  the  18 -state  filter  and  thus  the  filter  misestimates  0^. 
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Av.ii in  referring  tr>  Fig.  3.  2-3  ii  is  seen  that  uoer  clock 
relative  phase  error  is  strongly  influenced  by  altimeter  random  and 
neet,  leronieior  scale  faeior  errors.  Each  error  source  produces  about 
■10' e  of  the  total  mean  square  user  clock  phase  error.  At  first  glance  the 
accelerometer  scale  factor  contribution  to  user  clock  phase  error  may 
appear  surprising.  The  mechanizism  by  which  clock  phase  error  is 
recovered  in  (he  INI  configuration  was  discussed  in  detail  in  Section  2.4 
Ref.  1.  There  it  was  shown  that  the  rapidly  varying  geometry  modu¬ 
lates  the  projection  of  position  error  into  range  error  thus  causing  a 
spectral  separation  of  position  error  and  clock  phase  error  which  per¬ 
mits  each  to  be  estimated.  Position  errors  are  modulated  cyclically 
with  a  period  equal  to  the  time  of  flight  around  the  TRW  profile.  The 
position  errors  produced  by  accelerometer  scale  factor  error,  however, 
are  also  cyclic  since  they  couple  the  centrifugal  force  vector,  which  is 
rotating  in  the  navigation  frame,  into  the  navigation  error  process.  The 
cyclic  nature  of  accelerometer  scale  factor  error  induces  a  cycle  posi¬ 
tion  error  as  illustrated  in  Fig.  3.2-4a.  When  this  sinusoidal  position 

error  is  modulated  at  the  same  frequency  by  the  range  measurement 

2 

geometry,  the  result  is  to  produce  a  sin  cot  term.  But 


.  2  .  1  1 
sin  t-\ t  ~  2  ~  2  cos 


(3.2-3) 


so  that  accelerometer  scale  factor  induced  position  error  produces  a 
bias  and  twice  frequency  error  in  range  (i.e.  phase).  This  shows  up 
clearly  in  Fig.  3.  2- 4b  which  is  a  plot  of  accelerometer  scale  factor 
induced  user  clock  phase  error  as  a  function  of  time. 

Finally,  from  Fig.  3.2-3  it  is  seen  that  altimeter  random 
error  and  beacon  clock  drift  rates  are  the  major  contributors  to  user 
clock  frequency  error,  contributing  62%  and  25%  respectively  to  this 
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Figure  3.2-4  RMS  Errors  Produced  by 
Accelerometer  Scale 
Factor  Errors 


error.  This  should  be  contrasted  with  the  previous  20-state  filter  study 
(Ref.  1)  where  beacon  clock  drift  rates  contributed  87%  of  the  mean 
square  user  clock  frequency  error,  because  the  20-state  filter  did  not 
estimate  beacon  clock  drift  rate. 

In  summary  we  see  that  error  sources  which  are  not  modelled 
in  the  18 -state  Kalman  filter  are  the  major  contributors  to  all  important 


errors.  Altimeter  random  errors  and  accelerometer  scale 


factor  and  misalignment  errors  are  the  principle  sources  of  error.  The 
accelerometer  errors  are  important  because  of  the  constant  magnitude 
centrifugal  acceleration  experienced  in  the  selected  test  flight  profile. 


They  would  not  be  important  in  a  cruise 
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o, COM PAR1SON  OF  PREVIOUS  RESULTS  and  current  studies 


In  this  section  optimal  and  suboptimal  system  performance 
projections  for  the  current  study  are  compared  against  similar  results 
reported  in  Ref.  1.  The  differences  between  the  current  reference  error 
model  and  the  earlier  reference  error  model  were  discussed  in  detail  in 
Section  2.  First,  a  conventional  vertical  channel  damping  mechanization 
has  replaced  Kalman  processing  of  altimeter  data.  Secondly,  accelerom¬ 
eter  scale  factor  and  misalignment  errors  have  been  added.  Since  all 
other  conditions  of  the  two  simulations  were  identical,  the  difference  in 
predicted  performances  for  the  two  optimal  systems  must  be  caused  by 
these  model  differences.  Although  component  error  budgets  were  not 
run  for  the  optimal  systems  we  can,  with  a  high  degree  of  confidence, 
infer  the  effect  of  the  model  changes  on  predicted  optimal  performance 
from  the  suboptimal  error  budgets. 

Optimal  and  suboptimal  system  errors  at  the  end  of  three 
circuits  around  the  TRW  flight  profile  are  given  in  Table  3.3-1.  Refer¬ 
ring  to  the  table  we  see  that  optimal  radial  position  error  and  clock  phase 
error  in  the  current  study  are  roughly  double  that  predicted  for  the 
earlier  33-state  model.  This  increase  is  largely  attributable  to  the 
changeover  from  Kalman  processing  to  conventional  processing  of  altim¬ 
eter  data.  Predicted  optimal  radial  velocity  error  and  user  clock  fre¬ 
quency  error  are  up  by  approximately  a  factor  of  3,  due  both  to  the  added 
accelerometer  errors  and  changed  altimeter  data  processing.  The  head¬ 
ing  error  increase  of  some  80%  is  caused  by  accelerometer  misalign¬ 
ments  not  modeled  in  the  earlier  study. 

From  the  present  discussion  and  the  error  budget  study  of 
Section  3.2  it  is  clear  that  accelerometer  scale  factor  and  misalignment 
tojT  .  significant  sources  of  error  in  the  INI  system  using  the  TRW 
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profile.  Their  inclusion  in  the  reference  error  flight  model  results  in  a 
more  realistic  prediction  of  baseline  optimal  INI  system  performance. 


TABLE  3.3-1 

COMPARISON  OF  CURRENT  AND  PREVIOUS  RESULTS  FOR 
INI  SYSTEM  PERFORMANCE  PREDICTIONS 
(AT  T  =  1080  SECS) 


RMS  Error 

Previous  Study 

Current  Study 

Optimal 

15-State 

Optimal 

18 -State 

Heading  (min) 

0Z 

0.25 

0.48 

0.43 

0.80 

Position  (ft) 

6RN 

4.9 

18.2 

9.7 

15.1 

6Re 

4.4 

11.6 

8.6 

13.7 

6h 

5.7 

12.1 

12.2 

15.5 

|6R|* 

8.7 

24.7 

17.8 

25.6 

Velocity  (ft/sec) 

6Vn 

0.046 

0.14 

0.08 

0.15 

«vE 

0,034 

0.14 

0.08 

0.15 

6VZ 

0.030 

0.16 

0.14 

0.36 

|6V|* 

0.06 

0.25 

0.18 

0.42 

Altimeter  Bias  (ft) 

6hAl 

4.6 

7.0 

8.4 

8.8 

User  Clock 

6Tu(ft) 

4.6 

12.1 

9.7 

11.8 

6TU  (ft/sec) 

0.0079 

0.049 

0.020 

0.035 

*Total  radial  error  e.g. ,  |6R|  =  y6Rj^  + 


Comparison  between  suboptimal  filter  performance  predic¬ 
tions  in  the  two  studies  can  also  be  made.  The  appropriate  comparison 
here  is  between  the  15 -state  filter  of  Ref.  1  and  the  current  18 -state 
filter,  since  the  18 -state  filter  is  basically  the  old  15-state  filter  with 
the  three  beacon  clock  relative  drift-rates  added.  The  15/18-state  filter 
comparison  is  also  given  in  Table  3.3-1.  The  numerical  comparison  is 
largely  self-evident,  however,  two  points  are  worth  noting.  First,  on  a 
percentage  basis  the  18 -state  filter  is  much  closer  to  its  baseline  opti¬ 
mal  filter  than  the  15-state  filter  is  to  its  33-state  optimal.  Secondly, 
because  of  the  addition  of  beacon  clock  drift  rates  to  the  18 -state  filter, 
user  clock  errors  are  actually  lower  than  those  predicted  for  the  earlier 
15-state  filter. 


3 . 4  FILTER  INITIALIZATION  STUDIES 

The  performance  predictions  cited  so  far  in  this  section  were 
generated  assuming  that  the  initial  covariance  matrices  for  both  the 
reference  error  model  and  the  filter  design  model  are  diagonal.  During 
the  test  program,  however,  the  inertial  system  will  have  been  in  opera¬ 
tion  for  some  time  prior  to  entry  into  the  beacon  aided  mode  and  sub¬ 
stantial  cross -correlation  between  inertial  system  navigation  errors  and 
inertial  instrument  errors  will  undoubtedly  be  present.  Accordingly  the 
filter  initialisation  studies  to  be  described  had  two  broad  purposes.  The 
first  was  to  determine  filter  response  during  the  active  phase  to  more 
realistic  reference  inertial  system  initial  conditions  when  using  diagonal 
filter  covariance  matrix  initialization.  The  second  purpose  was  to  de¬ 
termine  if  more  realistic  filter  initial  conditions  could  be  obtained  at 
entry  into  the  active  phase  by  starting  the  filler  on  the  ground  prior  to 
t  alee -off. 
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3.4.1  Initialization  Study  No.  1 


In  order  to  generate  more  realistic  reference  system  initial 
conditions,  a  20-minute  free-inertial  flight,  starting  from  typical  initial 
conditions  produced  by  conventional  ground  alignment  techniques  was 
simulated.  A  northwest  flight  path  to  the  test  site  at  an  altitude  of  30,  000 
ft  and  velocity  of  400  ft/sec  was  used.  This  trajectory  was  selected  to 
approximate  a  flight  from  Holloman  AFB  to  the  WSMR  test  site .  This 
simulation  generated  a  full  reference  inertial  system  covariance  matrix 
upon  entry  into  the  active  phase  over  the  beacon  nei.  The  scenario  for 
the  first  initialization  study  is  shown  in  Pig.  3.4-1.  At  the  beginning  of 
the  active  phase  the  filter  covariance,  which  was  diagonal,  ms  initialized 
with  the  rms  values  shown  in  Table  3.4-1.  The  actual  inertial  system 
errors  at  this  time  are  shown  in  Table  3.4-2  where  the  optimal  and  18- 
state  filter  performances  are  compared  for  this  study. 
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FREE -INERTIAL  FLIGHT  TO  TEST  AREA 


ACTIVE  INI  PHASE 


T=-1200 


- 1  TIME 

T  =1080  sec 


Figure  3.4-1  Scenario  for  Initialization  Study  No.  1 


If  the  18 -state  filter  performance  in  this  study  is  compared 
with  results  cited  in  Table  3.1-1  at  the  end  of  two  and  three  circuits, 
they  are  seen  to  be  practically  identical.  As  indicated  in  Section 
3.1,  heading  error  is  one  of  the  more  difficult  errors  to  estimate  so 
that  a  comparison  of  time  histories  of  heading  error  give  qualitative  in¬ 
formation  on  the  relative  performance  of  a  given  filter  under  varying 
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TABLE  3.4-1 


INITIALIZATION  STUDY  NO.  1  RMS  INITIAL  VALUES  FOR 

18 -STATE  FILTER 


State  Symbol 


t  ‘  ‘ 

§ 

10 

6hA 

u 

6T 

t  ^ 

u 

i 

12 

6TU 

i 

f 

e  f 

13 

6T2 

f 

£ 

14 

^2 

1  *  * 

15 

6T3 

r 

• 

|  -  ~ 

£  * 

16 

6T3 

s 

5 

17 

6T4 

t?  *  w- 

• 

i  l 

18 

6T, 

Description 


North  \ 

East  \  Posit 
Vertical  ) 

North  \ 

East  >  Veloc 
Vertical  ' 

North  \ 

East  >  Platf< 
Vertical  / 
Altimeter  Bias 
Phase  Error 
Frequency  Error 
Phase  Error 
Frequency  Error 
Phase  Error 
Frequency  Error 
Phase  Error 
Frequency  Error 


Position  Error 


Velocity  Error 


Platform  Tilt 


User* 


Beacon  No. 2* 


Beacon  No.3* 


Beacon  No. 4* 


RMS  Initial  Value 

3000  ft 

3000  ft 

200  ft 

4  ft/sec 

4  ff/sec 

0.5  ft/sec 
__ 

0.4  min 

0. 4  min 

3.0  min 

200  ft 

104  ft 

10  ft/sec 
4 

10  ft 


10  ft/sec 
104  ft 
10  fl/sec 

4 

10  ft 
10  ft/sec 


♦Relative  to  Beacon  No.  1 
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TABLE  3.4-2 

INIHALI Z ATION  STUDY  NO.  -1  -  OPTIMAL  AND  18 -STATE 
FILTER  PERFORMANCE  COMPARISON 


RMS 

T  =  0  sec 

T  *  360  sec 

End  1st  Circuit 

T  =  720  sec 

End  2nd  Circuit 

J 

T  -•  1080  sec 

End  3rd  Circuit 

Error 

Units 

System 

Optimal 

18 -State 

Optimal 

1 8  -State 

Optimal 

18-State 

0Z 

min 

3.02 

0.99 

1.39 

0.47 

0.85 

0.42 

0.81 

6Rn 

ft 

2270 

31.1 

50.2 

11.1 

17.5 

8.9 

15.1 

6Re 

2244 

23.9 

38.8 

9.5 

14.8 

8.3 

13.7 

oh 

202 

15.1 

19.9 

13.0 

16.2 

12.1 

15.8 

,  m 

ft 

3198 

42.0 

66.5 

19.6 

28.1 

17.2 

25.8 

6Vn 

3.2 

0.21 

0.28 

0.091 

0.153 

0.075 

0.151 

6Ve 

ft/eec 

3.1 

0.29 

0.42 

0.067 

0.155 

0.065 

0.154 

6VZ 

0.35 

0.17 

0.32 

0.15 

0.35 

0.14 

0.36 

|6V| 

ft/sec 

4.47 

0.40 

0.60 

0.187 

0.41 

0.17 

.  0.42 

6hA 

ft 

200 

12.2 

17.4 

9.2 

10.2 

8.2 

9.3 

6Tj 

ft 

104 

21.7 

31.0 

10.1 

12.1 

9.3 

12.3 

6Tj 

ft/sec 

10 

0.10 

0.17 

i 

0.022 

0.031 

0.020 

0.034 

initial  conditions.  Heading  error  time  histories  for  the  18 -state  filter  in 
the  baseline  performance  run  of  Section  3 . 1  and  the  present  initialization 
study  are  shown  in  Fig.  3.4-2.  Note  the  great  similarity  in  these  curves. 
The  major  conclusion  to  be  drawn  from  this  first  initialization  study  is  that 
the  18 -state  filter  is  largely  insensitive  to  the  presence  of  off-diagonal 
terms  in  the  reference  system  initial  covariance  matrix.  Alternately, 
the  filter's  lack  of  knowledge  of  significant  initial  cross-correlations  in 
reference  system  errors  does  not  materially  degrade  its  performance. 
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Figure  3.4-2  18-State  Filter  Heading  Error  Time  Histories  for 
the  Baseline  Run  Initialization  Study  No.  1(b) 


3o4„2  Initialization  Study  No.  2 

If  the  errors  of  the  optima,!  filters  in  the  baseline  performance 
evaluation  of  Section  3.1  and  the  first  initialization  study  are  compared,  it 
is  seen  that  the  latter  are  generally  smaller.  In  particular ,  heading  error 
at  the  end  of  one  circuit  is  much  smaller  in  the  first  initialization  study 
(0. 99  rnin  vs  1. 34  mm).  Thus  it  appears  that  cross-correlation  between 
various  system  errors  when  present  and  known  to  the  filter  can  result  in  im¬ 
proved  transient  performance  and  somewhat  lower  steady-state  errors.  The 
second  initialization  study  was  made  to  determine  whether  or  not  the  18-state 
filter  could  be  made  to  generate  the  appropriate  cross-correlations  in  its  co- 
variance  computations .  In  order  t^  do  this,  filter  estimates  of  system  errors 
must  be  strongly  correlated  with  actual  system  errors  at  some  previous  time 
(i.  e. ,  the  filter  must  update  the  system  with  external  data).  This  was  accom¬ 
plished  by  simulating  a  Kalman  ground  align  mode .  In  this  mode  the  airc  raft 
remains  stationary  at  a  known  point.  The  Kalman  filter  is  configured  to  accept 
position  and  velocity  fixes  corresponding  to  this  known  point  and  zero  velocity. 
The  Kalman  filter  is  then  used  to  predict  inertial  system  error  build-up  during 
the  flight  to  the  beacon  net. 
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In  this  study  a  10-min  ground  align  was  first  simulated.  Position 
was  assumed  to  be  known  to  within  a  bias  of  10  ft  per  axis  although  this  bias 
was  not  modeled  in  the  18- state  filter.  An  rms  velocity  measurement  error 
of  0. 2  ft/sec  was  also  assumed  to  account  for  wind  gusts  and  aircraft  loading 
effects.  Velocity  andposition  fixes  were  processed  every  6  seconds.  The 
scenario  for  the  second  initialization  study  is  shown  in  Fig.  3.4-3. 
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Figure  3.4-3  Scenario  for  Initialization  Study  No.  2 


Optimal  and  18-state  filter  performance  in  the  second  initiali¬ 
zation  study  is  summarized  in  Table  3.4-3.  During  the  active  phase 
optimal  filter  errors  in  all  categories  are  somewhat  lower  than  those  in 
any  of  the  earL  r  simulations.  The  18-state  filter  error  performance, 
however,  at  the  end  of  3  circuits  over  the  beacon  ret  is  essentially  the 
same  as  before,  with  the  exception  of  heading  error  which  is  actually 
somewhat  worse  than  in  the  first  study,  i.  e. ,  0.  S3  mih  vs  0. 81  mm. 

It  is  very  difficult  to  isolate  the  exact  cause  for  this  small  in¬ 
crease  in  heading  error  without  additional  analysis.  However,  some 
general  observations  can  be  made.  Looking  back  to  the  end  of  ground 
align  it  is  seen  that  18-state  filter  errors  are  very  close  to  optimal.  This 
is  so  because  errors  in  both  the  optimal  and  suboptimal  filters  at  this 
time  are  largely  controlled  by  the  external  velocity  and  position  informa¬ 
tion  which  is  very  accurate.  At  the  end  of  the  20-min  flight  to  the  test 
area,  however,  18-state  filter  radial  position  error  at  1054  ft  is  some 


6  times  worse  than  optimal.  This  result  is  perhaps  not  unexpected  since 
the  18-state  filter  was  optimized  for  processing  beacon  data  at  a  high 
rate  and  not  for  long-term  extrapolation  of  inertial  system  errors.  The 
covariance  matrix  computed  by  the  18-state  filter  at  this  time  not  only 
underestimates  the  true  rms  value  of  all  system  errors  but  also  errs  in 
the  ratio  of  these  errors.  For  example,  true  rms  north  and  east  posi¬ 
tion  errors  shown  in  Table  3.4-3  at  T  =  0  are  roughly  equal  at  786  and 
702  ft,  respectively.  However,  the  18-state  filter  covariance  computa¬ 
tion  places  the  rms  north  and  east  position  errors  at  this  time  at  770  and 
498  ft,  respectively.  Similar  errors  in  magnitude  and  ratio  are  present 
in  the  velocity  and  tilt  angle  covariances.  This  suggests  that  the  un¬ 
modeled  errors  cause  the  covariance  matrix  computed  in  the  18-state 
filter  algorithm  over  the  20-min  Kalman  inertial  flight  to  be  incorrect 
not  only  in  rms  value  but  also  in  important  off-diagonal  terms,  which 
may  account  for  the  increased  heading  error. 

In  terms  of  final  system  accuracy  at  the  end  3  circuits  over 
the  beacon  net,  there  appears  to  be  no  advantage  to  mechanizing  a  Kalman 
ground  align  mode.  However,  with  ground-align,  18-state  filter  errors 
are  substantially  lower  upon  entry  into  the  beacon  net  than  those  predicted 
for  the  free-inertial  flight  to  the  test  area.  This  latter  fact  may  be  signi¬ 
ficant  in  reducing  time  required  to  put  the  receiver  into  its  aided  acquisi¬ 
tion  mode  and  in  reducing  nonlinear  measurement  effects  peculiar  to  the 
short  baseline  be.  '.on  geometry  (as  opposed  to  operational  satellite 
deployment)  as  discussed  in  Ref.  4. 

3.  5  PERFORMANCE  EVALUATION  SUMMARY 

The  performance  evaluations  reported  in  this  section  indicate 
that  an  18-state  INI  Kalman  filter  mechanization  can  provide  navigation 
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accuracies  consistent  with  the  INI  test  objectives.  In  particular,  these 
studies  show  that  highly  accurate  pre-flight  synchronization  of  beacon 
clocks  is  not  required  and  that  the  IB- state  filter  Is  relatively  insensi¬ 
tive  to  initial  condition  uncertainties  in  general. 

The  vertical  diannel  mechanization  proposed  by  TRW  should 
produce  acceptable  vert ical  channel  accuracy  while  greatly  reducing  the 
possibility  of  Kalman  tilter  divergence.  The  error  budget  studies  have 
shown,  however,  that  an  modeled  system  error  sources,  and  in  particu¬ 
lar  altimeter  and  accelerometer  errors,  are  major  contributors  to  nav¬ 
igation  errors  with  the  18-state  filter  mechanization.  Thus  in  any 
move  to  increase  filter  state  size,  inclusion  of  these  errors  should  be 
considered. 
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4. 


TRW  INI  TEST  PLAN  REVIEW 


(I)  The  INI  flight  test  objectives  are  described  in  Section  2  of 
Ref.  4  and  the  general  test  plan  is  contained  in  Ref.  7.  The  major 
objective  of  the  test  program  is  to  demonstrate  that  a  single  channel 
receiver  can  sequentially  acquire  signals  from  a  set  of  beacons  under 
computer  control  using  filtered  inertial  system  data.  Additional  objec¬ 
tives  are  the  evaluation  of  integrated  system  accuracy  and  software 
(Kalman  filter,  receiver  aiding  algorithms,  etc.)  performance. 

(II)  As  part  of  the  study  effort  described  herein,  TASC  undertook 
a  review  of  the  TRW  INI  test  program.  This  review  was  directed  pri¬ 
marily  toward  the  unique  problems  which  arise  in  the  testing  of  Kalman 
filter  integrated  systems.  More  specifically  the  review  was  aimed  at 
ascertaining  whether  adequate  data  are  being  taken  for  both  in-flight  and 
post-flight  filter  evaluation  and  trouble  shooting  and  whether  appropriate 
filter  diagnostic  procedures  are  available  to  pinpoint  filter  deficiencies 
and  incorporate  appropriate  design  changes  into  the  test  program. 

A  brief  description  of  the  flight  instrumentation  will  aide  in 
understanding  the  TASC  comments.  The  flight  instrumentation  consists 
of  real-time  (or  near  real  time)  displays  and  a  tape  recorder.  The  real 
time  displays  include  a  control  and  display  unit,  an  analog  strip  chart 
recorder  and  a  printer.  The  real  time  displays  monitor  system  status 
and  performance  and  are  intended  to  give  the  operator  data  to  assess  the 
progress  of  the  test,  alter  the  flight  test  plan,  adjust  and/or  repair  equip¬ 
ment,  and  make  unscheduled  inputs  to  the  flight  program.  The  tape  re¬ 
corder  is  intended  to  record  sufficient  data  for  post -flight  analysis  and 
reconstruction. 


The  TRW  approach  to  flight  data  recording  is  basically  to 
obtain  sufficient  data  to  assess  INI  system  accuracy,  reconstruct  the 
flight  trajectory,  and  to  "refly"  the  Kalman  filter  in  a  ground-based 
interpretative  computer  simulation.  Thus  there  is  no  exhaustive,  step-by- 
step  recording  of  program  variables  in  each  computation  cycle.  Typical 
of  the  data  to  be  recorded  are 


Cl 

o 


receiver  input/output  words 
altimeter  data 
IMU  accelerometer  outputs 
IMU  gyro  torquing  signals 
IMU  gimbal  angles 
IMU /INI  misalignment  angles 
INI  Navigation  outputs 
IMU  Navigation  outputs 
Kalman  state  vector 

Kalman  filter  covariance  matrix  diagonal  elements 
Time 


The  real-time  display  consists  of  a  Control  and  Display  unit,  an  analog 
strip  chart  recorder,  and  a  printer.  The  printer  outputs  essentially  the 
same  kind  of  data  as  listed  above  and  is  the  primary  source  of  informa¬ 
tion  for  in-flight  assessment  of  system  performance. 

TASC  has  reviewed  the  INI  general  test  plan  (Ref.  7)  and 
offers  the  following  over-all  comments: 


•  The  flight  profiles  and  flight-test  sequence 
recommended  by  TRW  appear  consistent 
with  the  flight-test  objectives. 
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©  Sufficient  data  are  being  recorded  for  proper  post- 
flight  evaluation  in  accordance  with  the  TRW 
philosophy  cited  above. 

o  In-flight  data  displays  to  the  operator  are  not  of  a 
form  which  best  permits  rapid  and  direct  assess¬ 
ment  of  filter  performance. 

The  last  comment  requires  additional  amplification.  In  order 
to  achieve,  the  primary  test  objective  of  successful  receiver  operation  in 
the  inertially  aided  mode,  the  Kalman  filter  must  converge.  The  only 
direct  measure  of  Kalman  filter  convergence  available  in  real-time  is 
the  measurement  residuals,  specifically  the  range  and  range-rate  diver¬ 
gences.  Recall  from  Section  2  of  Ref.  1  that  these  quantities  are  the 
difference  between  measured  ^ange  (range-rale)  and  range  (range-rate) 
computed  (i.c.  estimated)  from  INI  navigation  quantities.  If  the  Kalman 
filter  has  converged  these  differences  will  be  consistently  "small”  in 
some  statistical  sense.  If  these  differences  are  not  "small"  corrective 
action  can  be  initiated  by  the  operator.  Such  action  could  include  filter 
reinitialization. 


The  data  called  out  in  Ref.  7  for  printer  display  does  not 


directly  measure  filter  convergence. 


77V>  v* 


OVO  VY\v\1  r\ 


both  free  inertial* 


and  integrated  NAVSAT/inertial  position  and  velocity  are  printed.  How¬ 
ever,  one  would  not  expect  these  two  sets  of  variables  to  agree,  except 
in  some  gross  sense.  Thus  differences  in  these  quantities  do  not  neces¬ 
sarily  imply  poor  filter  performance.  We  note  that  the  display  of  selected 
Kalman  measurement  residuals  is  suggested  in  ReL  4,  yet  they  are 
absent  from  the  printer  variable  list  given  in  Ref.  7. 


*Bolh  the  aided  and  free-inertial  navigation  solution  are  computed  in 
flight. 
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SUMMARY  AND  RECOMMENDATIONS 


In  the  first  portion  of  this  study  a  revised  INI  error  model  was  j 

developed.  The  major  changes  in  this  model  were  the  addition  of  accel¬ 
erometer  scale  factor  and  misalignment  errors,  the  switch  to  conventional 

| 

barometric  altimeter  damping  of  the  vertical  channel  mechanization,  and  . 

the  use  of  coarsely  synchronized  beacon  clocks „  The  change  from  accu-' 
rate  to  coarse  beacon  clock  synchronization  made  it  necessary  to  estimate 
beacon  clock  drift  rates  in  the  INI  Kalman  filter.  This  required  the  addi¬ 
tion  of  three  states  to  the  15-state  Kalman  filter  mechanization  described 
in  Ref.  1.  A  performance  evaluation  of  the  resulting  18-state  filter, 
including  a  comparison  against  a  fully  optimally  integrated  INI  system 
was  then  reported.  The  results  of  this  evaluation  may  be  summarized 
as  follows: 

o  Predicted  baseline  optimal  navigation  errors  with 
the  revised  INI  refeience  error  model  are  roughly 
a  factor  of  two  larger  than  the' original  predictions 
made  by  TASC  in  Ref.  1.  For  example,  predicted 
rms  radial  position  error  has  increased  from 
8.7  ft  to  17.8  ft. 

o  Projected  navigation  performance  of  the  18 -state 
INI  Kalman  filter  is  acceptable  and  consistent  with 
the  INI.  test  objectives. 

o  Altimeter  random  errors  and  accelerometer  .scale 
factor  and  misaligmnent  errors  are  the  major 
sources  of  system  error  in  the  flight  profiles 
studied.  These  errors  are  not  modelled  in  the 
18 -state  filter. 

e  The  conventional  vertical  channel  mechanization 
proposed  by  TRW  is  satisfactory,  It  provides  the 
required  vertic-  <  channel  stabilization  at  the 


expense  of  somewhat  greater  system  sensitivity 
to  altimeter  random  errors  than  Kalman  process- 
ing  of  altimeter  data. 

©  The  18-state  filter  is  relatively  insensitive  to 
initial  condition  uncertainties. 

The  study  then  turned  to  a  discussion  of  the  TRW  test  program,  with 
special  emphasis  on  the  Kalman  filter  related  portions  of  the  tests.  It 
was  generally  concluded  that  the  flight  test  profiles,  and  flight  data  re¬ 
cording  were  appropriate  to  the  flight  test  objectives.  However,  it  was 
felt  that  the  in-flight  displays  to  the  operator  were  not  the  most  appro¬ 
priate  for  rapid  assessment  of  proper  Kalman  filter  operation. 

Based  upon  the  studies  summarized  above  the  following  recom¬ 
mendations  are  offered: 

a  Mechanize  an  18-state  INI  Kalman  filter  for  use 
in  the  initial  aided  flights. 

©  Provide  real-time  display  of  selected  Kalman 
filter  measurement  residuals  and  statistical 
evaluation  of  these  residuals  as  discussed  in 
Section  4,  to  permit  rapid  evaluation  of  filter 
convergence  and/or  appropriate  in-flight 
corrective  action. 
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APPENDIX  A 


STATE  SPACE  SPECIFICATION  OF  THE 


INI  REFERENCE  ERROR  MODEL 


A.  1  INTRODUCTION 


In  order  to  use  the  covariance  equations  of  error  analysis 
developed  in  Ref.  2,  the  reference  system  error  equations  must  be  written 
in  vector-matrix  or  state-space  form.  These  equations  are  specified  by 
the  following  reference  system  elements: 


x 


F  = 


Q  = 


H  = 
P 

R  = 
P 

H.  = 
P 

R.  = 
P 


state  vector 

dynamics  matrix 

system  noise  covariance  matrix 

initial  condition  matrix 

range  measurement  matrix 

range  measurement  noise  covariance  matrix 

range-rate  measurement  matrix 

range-rate  measurement  noise  covariance 
matrix 


The  33  components  of  the  INI  system  reference  error  model 
state  vector  and  their  initial  values  were  defined  in  Table  2.1-2.  The  re¬ 
maining  matrices  v.lvch  define  this  model  are  presented  in  this  appendix. 
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A.  2  REFERENCE  SYSTEM  F  AND  Q  MATRICES 


The  reference  system  F  matrix,  in  partitioned  form,  is  given 

below: 
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*Numbers  indicate  columns  occupied  by  each 
partition.  Refer  to  Table  2. 1-2  for  defini¬ 
tion  of  state  vector  elements. 


In  the  above  equation  F^  is  the  9x9  dynamics  matrix  of  inertial  system 
errors.  Similarly,  F^g  describes  the  baro -altimeter  error  dynamics  and 
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the  user  and  beacon  clock  error  dynamics.  The  gyro  and  acceler¬ 


ometer  error  states  are  characterized  as  biases  and  therefore  have  zero 
self-coupling  as  illustrated  in  Eq.  (A.  2-1).  Matrices  F^g?  F^and  F^ 
provide  for  the  coupling  of  the  baro  altimeter,  and  gyro  and  accelerometer 
errors  into  the  inertial  system  error  states.  These  submati'iees  are  spe¬ 
cified  in  Eqs.  (A.  2-2)  through  (A.  2-6). 
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where 


r  =  R  +  h 
e 

R  =  earth’s  radius 
e 

V  =  north  component  of  velocity 

IN 

V_  =  east  component  of  velocity 
E 

V  =  vertical  component  of  velocity 

/.i 

g  =  gravity 

0,  =  earth  rate 

L  =  vehicle  latitude 

A^  =  north  component  of  specific  force 

A_e  =  east  component  of  specific  force 

A_.  =  vertical  component  of  specific  force 

Zj  < 


(A. 2-3) 


The  reference  system  Q  matrix  contains  the  spectral  levels  of 
the  white  noise  inputs  to  the  various  system  error  states.  The  partitioned 
form  of  the  Q  matrix  is  given  as  follows 


Q  - 


1-9 

10-11 

12-17 

18-25 

26-33 

Q11 

1 

J 

1 

l 

0 

1 

1 

I 

1 

0 

0 

1 

1 

1 

1 

0  ~ 

0 

1 

I 

I 

Q22 

f 

i 

i 

0 

0 

1 

1 

I 

0 

0 

l 

1 

I 

0 

i 

i 

i 

0 

0 

I 

1 

1 

0 

0 

1 

l 

1 

0 

t 

i 

i 

i 

0 

0 

1 

1 

1 

0 

0 

1 

\ 

1 

I 

1 

0 

i 

t 

i 

i 

0 

0 

1 

\ 

1 

\ 

1 

Q55 

(A.  2-7) 


and  the  submatrices  are  given  below. 
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q  =  2a.  T.  i  =  4,  5,  6,  7,  8,  9 

I  1  JL  ' 

variance  of  Markov  noise 
correlation  time  of  Markov  process 
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The  system  noises  defined  in  Eq.  (A.  2-8)  represent  accelerometer  (4,  5, 
6)  and  gyro  (7,  8,  9)  errors  whose  bandwidth  is  greater  than  the  system 
bandwidth  and  can  be  approximated  with  white  noise  of  spectral  level  given 
by  Eq.  (A.  2-9).  The  system  noise  covariance  associated  with  the  baro- 
altimeter  is  given  by 


Q22  " 
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where 

2 

cr^  =  altimeter  Markov  error  variance 

=  altimeter  Markov  inverse  correlation  time 

The  final  submatrix  of  Q  is  associated  with  the  user  and  beacon  clocks 
and  is  specified  by  the  following  expression 


%5  = 


q26  0 
0  <*27 


q28  0 
0  0 


q30  0 
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q32  0 
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(A .  2-11) 


where  q^,  (i  =  26,  28,  30,  32)  is  the  white  noise  input  to  each  clock 
phase  integrator.  The  values  for  these  white  noises  are  given  below 


q^g  =  0.02  ft  /sec 

in-6  .,2 /  3 

q27  =  10  ft  /sec 


(A.  2-12) 
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q^g  =  2.0x10  ^  fl^/sec 
q30  =  q32  =  q2B 


A.  3  REFERENCE  SYSTEM  H  AND  R  MATRICES 

Application  of  the  Kalman  algorithm  to  evaluation  of  the  INI 
system  requires  definition  of  both  the  measurement  matrix,  H,  and 
measurement  noise  covariance  matrix,  R,  associated  with  each  measure¬ 
ment.  This  measurement  has  the  general  form 


z  =  H  x  +  v 
-n  n-n  —  n 


(A.  3-1) 


where 


=  the  measurement  vector  under  consideration  at 
time  t 

n 

=  the  matrix  describing  the  linear  combination  of 
state  variables  which  comprise 

=  a  vector  of  zero  mean  white  noise  with  covariance 

R  at  t  ,  i.e.,  R  =  E  [v  vT] 
n  n’  n  L- n  ~n J 


The  measurements  in  this  system  consist  of  range  divergence  and  range- 
rate  divergence  to  each  beacon.  These  equations  were  specified  in 
Section  3  of  Ref.  1.  They  are  repeated  below  for  completeness. 

The  range  divergence  can  be  written  as 


Ap-  =  H  x  +  v 
'i  o,  -  c 


(A.  3-2) 


where 


R  =  E  \v  ] 

r\  •' 


(A.  3-3) 


th 

and  the  subscript  i  represents  the  i  beacon.  Expressing  the  unit  vector 
th 

between  user  and  i  *  beacon  as 


7Ni 

yEi 

7Zi 


,  i  =  1,  2,  3,  4 


The  matrixes  Ii  and  R  can  be  written  as  follows; 
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The  general  expression  for  the  range-rate  divergence  is  given 


as 


Ao  -  H-  x  +  v 


(A.  3-6) 


where 


R.  =  E  [v-  1 


(A.  3-7) 


Using  Eq.  (3.1-2)  of  Ref.  1  the  matrices  Hb  and  R^  are  readily 
formed  as 
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and 


R  . 
P- 


a  ■ 


(A.  3-9) 


The  first  three  elements  in  the  matrix  H .  were  defined  as  the  vector  of 

P 

position -to -velocity  error  influence  coefficients  in  Section  3  of  Ref.  (1). 
These  values  are  specified  by  the  following  relationship,  derived  in  Ref.  5: 


e .  =  — 
-1  Pi 


-Pi 
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(A.  3-10) 
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B.  f  INTRODUCTION 

A  filler  design  model  is  specified  by  a  set  of  elements  analo¬ 
gous  to  those  vised  to  specify  the  reference  error  model.  Thus,  one  must 
specify  (he  filter  design  model  state  vector,  a  design  model  dynamics 
matrix,  noise  matrix,  initial  condition  matrix,  etc.  Adopting  the* notation 
of  Ref.  2,  the  design  model  elements  will  be  differentiated  from  fhe  refer¬ 
ence'  or  ’’real  worltT  elements  through  the  use  of  a  superscript  (*)  nota¬ 
tion.  Accordingly,  the  filter  design  is  specified  by  the  following  elements: 

1  f 

x*  ss  the  design  model  state  vector 

F*  -  the  design  model  dynamics  matrix 

Q*  =  the  design  model  noise  covariance  matrix 

P*  -  the  design  model  initial  covariance  matrix 

H*  =  the  design  model  range  measurement  matrix 
P 

R*  =  the  design  model  range  measurement  noise 
p  covariance  matrix 

H*  -  the  design  model  range-rate  measurement 
p  matrix 

R*  *  the  design  model  range-rate  measurement 
p  noise  covariance  matrix  * 
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B.  2  THE  18-STATE  INI  KALMAN  FILTER  DESIGN  MODEL 


The  elements  of  the  18-,state  filter  state  vector  together  with 
their  assumed  initial  values  were  defined  in  Section  2.1.  The  remaining 
matrices  required  to  complete  the  specification  of  this  filter  design  model 
are  presented  in  this  subsection. 


The  18 -state  dynamics  matrix; based  on  the  state  vector  as 
defined  in  Table  2.3-1.  The  resulting  matrix  is 
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TABLE  B.  2-i 


DIAGONAL  ELEMENTS  OF  THE  Q*  MATRIX 
FOR  THE  15 -STATE  FILTER 


Element 

Value 

q*3 

44.0 

ft^/sec 

q*4,  q*5 

2.0  x 10“5 

ft2/sec 

q*6 

1.3  x  10“2 

ft2/s  I 

q*7,  q*8 

4.0  x  10"6 

Cl 

min4/sec. 

q*9 

2  x  10"5 

•  2/ 

mm  /sec 

q*36 

0.75 

^2 

ft 

The  measurement  and  measurement  noise  matrices  for  this 
filter  are  given  as 


H* 

Pi 


1  3  11 

I 

[yNiyEi  yZi  |  °  ’  *  *  1  0  ‘ 


9  +  2i 

.  -k  0  .  .  .] 

(B.  2-8) 


where  k  =  0  for  i  =  1  and  k  =  1  for  i  =  2,  3,  4. 


R*  =  fa*  Y  (B. 2-9) 
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is 
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Pi 
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(B.  2-11) 

\  Pj/ 

Values  for  the  white  measurement  noises  are  given  in  Table  B.2-2. 

TABLE  B.2-2 

DESIGN  VALUES  FOR  18 -STATE  FILTER 
WHITE  MEASUREMENT  NOISES 


Error 

RMS  Value 

Range 

Range -Rate 

8  ft 

1  ft/sec 
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